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VERFAHREN ZtIM EINMESSEN EHJES AEBEITSHJHKTES VQN WERK2BDGEK FDR HJDDSTRIEROBOTER 



Die Erflndung betrifft ein Verfahren zum Einmessen eines Arbeitspunktes von 
Werkzeugen fQr Industrieroboter mit einer Einmessvorrlchtung, die mindestens 
5 zwei jeweils mit einem Scheitelwinkel a grdSer Null winklig zueinander 
stehende und sich in einem Kreuzungspunkt kreuzende LIchtschranken hat und 
folgende Schritte aufweist: 

a) Festlegen von IST-TCP-Lagekoordinaten eines SOLL- 
10 Arbeitspunktes des Werkzeugs bezogen auf einen 

Werkzeugbasispunkt eines 
I Industrieroboters und eines auf den Arbeitspunkt bezogenen TCP- 

I Koordinatensystems, 

I 15 b) Verfahren des Werkzeugs mit Bezug auf das TCP- 

t 

I Koordinatensystem durch die Lichtschranken so, dass die dem 

I Arbeitspunkt entsprechende Werkzeugspitze des Werkzeugs die 

I LIchtschranken unterbricht. 

i 20 Industrieroboter haben zum Anfahren beliebiger Punkte innerhalb eines 
Arbeltsraums mehrere mlteinander verbundene Arme, elnen Handfiansch am 
oter(8) ^"^^^^ letzten Anns der mlteinander verketteten Amne, und ein Werkzeug, 

Handfiansch angebnacht ist. Das Werkzeug kann beisplelsweise ein 
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Greifer, ein Schweifikopf oder Shnliches sein. 
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Die Lags un d Orien tiemng des Handflansches oder des Arbeitspunktes eines 
an den Handflansch angebrachten Werkzeugs kann in' einem qrtsfesten 
roboterunabhSngigen Weltkoordinatensystem Oder einem ortsfesten auf einen 
Verankerungspunkt des Industrieroboters bezogenen Basiskoordinatensystem 
5 erfolgen. Die Beschreibung der Lage der Freiheitsgrade, d. h. der Achsen und 
der Handorientlerung erfolgt hingegen in Roboterkoordinaten, wobei ausgehend 
von der Grundaclise des Roboters, d. h. des Basiskoordinatensystems, fur 
jeden Arm ein Achsen-Roboterkoordinatensystem definiert ist, das die relative 
Lage jeder Achse bezogen auf ihre vorgehende Achse beschreibt. Der 
0 Zusammenhang der Adisen-Roboterkoordinatensysteme eines 
Industrieroboters* wird durch definlerte Koordinatentransfonmationen 
beschrieben. Durch Vorgabe der Lage und der Orientiemng des Handflanscii 
Oder des Arbeitspunktes eines Werkzeugs im Weltkoordinatensystem kSnnen 
somit durch Koordinatentransformation die Achs en"Roboteri<oo rdinat en 
5 berechnet werden, urn die einzelnen Achsen des Industrieroboters ansteuem 
zu konnen. 

Die Lage eInes AriDeitspunktes eines Weri<zeuges, das an den Handflansch des 
Industrieroboters angebracht wird, wird durch sogenannte TCP- 
Lagekoordinaten beschrieben. Die Programmierung des Industrieroboters 
erfolgt auf der Basis des Handflanschs und der festgelegten TCP- 
Lagekoordinaten. Die TCP-Lagekoordinaten werden bei jedem Werkzeug 
mitgeliefert und slnd als Tool-Center-Polnt (TCP) bekannt Die TCP- 
Lagekoordinaten sind ebenso wie die Achsen-Roboteri<oordinaten jev\^eils ein 
Vektor mit sechs Dimensionen. Die ersten drei Koordinaten definieren die Lage 
des Arbeitspunktes relativ zu dem Werkzeugbasispunkt des Industrieroboters, 
d. h. des Befestigungspunktes des Werkzeugs an dem Handflansch. Die 
anderen drei Koordinaten definieren die Orientierung der Achsen des 
Arbeitspunktes relativ zu dem Weritzeugbasispunkt. 
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Der Arbeitspunkt des Werkzeugs kann belspielsweise die Spitze eines 
SchweiSkopfes sein. Nur wenn die TCP-Lagekoordlnaten exakt bekannt sind, 
kann der Arbeitspunkt des Werkzeugs prazise verfahren werden. 

!m Betrleb kann sich der Arbeitspunkt des Werkzeugs jedoch durch 
WerkzeugverschleiB, Verbiegung etc. Sndem, was zu einer fehlerhaften 
Positionierung des Arbeitspunktes des Werkzeugs fQhrt 

Es besteht daher die Notwendigkeit den Arbeitspunkt von Werkzeugen 
hochgenau einzumessen. 

In der EP 0 417 320 A1 ist ein Verfahren zum Einmessen des Arbeitspunktes 
(TCP) des Werkzeuges eines Industrieroboters besclnrieben, bei dem ein 
Einstellpunkt an dem Handf lansdi des Ro botera rms festgelegt ist w obei d ie 
Position des Einsteilpunktes relativ zu dem Handflansch bekannt ist Weiterhin 
ist eine Referenzspitze Im Arbeitsraum des industrieroboters aufgestellt Zum 
Einmessen des Arbeitspunktes wird die Spitze des Werkzeugs auf die 
Referenzspitze aufgesetzt und die Position und Orientierung der 
Werkzeugspltze in einem Basiskoordinatensystem bestimmt Dann \Mrd der 
Einstellpunkt des Handflansches auf die Referenzspitze aufgesetzt und die 
Position und Orientierung des Einsteilpunktes in dem Koordinatensystem des 
Handflansches bestimmt Zudem wird die Position und Orientierung der 
Referenzspitze in dem Bezugskoordinatensystem bestimmt und aus den drei 
Matrizen eIne Transfonnationsmatrix zur Bezeichnung der TCP- 
Lagekoordinaten des Arbeitspunktes des Werkzeuges berechnet 

Das Einmessen eri=ordert einen mehrstufigen Verfahr-Vorgang sowie 
Koordinatentransfomiationen. 

Aus dem US-Patent 6,352,354 B1 ist ein Lichtpunktelement zur Erzeugung 
eines Lichtpunktsignals an einem Arbeitspunkt eines Industrieroboter- 
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Werkzeugs beschrieben. Hierdurch kann die gsnaue Position des Werkzeugs 
wahrend einer Lemphase beschrieben werden. 

In dem US-Patent 5,929,584 ist ein Verfahren zum Einmessen eines 
Arbeitspunktes von Werkzeugen mit einem Kalibrierblock beschrieben, der 
vertikale und horizontale FlSchen hat Durch Bewegung des Werkzeugs von 
einer Startposltion bis zu einem BerOhrungspunkt des Werkzeugs an einer der 
Flachen und ZurQckfahren des Werkzeugs zum Startpunkt und Wiederhden 
des Vorgangs fQr die andere FiSche werden die TCP-Lagekoordinaten des 
Arbeitspunktes berechnet. Hiensu ist nachteilig eine aufwSndige 
Koordinatentransformation von dem Bezugskoordinatensystem uber die 
einzelnen Roboterkoordinaten bis zu dem Handflansch erforderlich, urn aus den 
Bezugskoordinaten die TCP-Lagekoordinaten im TCP-Koordinatensystem zu 
ermitteln. 



In der DE 37 24 656 T2 ist eine mehrdimensionale Messmaschine mit 
Gabellichtschranke beschrieben, die sich an einem Kreuzungspunkt treffen. Auf 
Gmnd der mehreren Lichtschranken, die alle in der gleichen Ebene liegen, kann 
eine berCihrungslose Antastung des Werkstucks von unterschiedlichen 
Richtungen, aber in der selben Antastebene erfoigen. 

Das US-Patent 5,177,563 offenbart eine Gabellichtschranke zur Kalibriemng 
eines Roboteramns, dass dieWerkzeugsspitze solange verfahren wlrd, die bis 
diese im dem Kreuzungspunkt der Lichtschranken liegt und beide 
Lichtschranken gleichzeitig ausgelost sind. Die TCP-Lagekoordinaten in diesem 
Kreuzungspunkt werden mit SOLL-TCP-Koordinaten verglichen und hieraus 
eine Abweichung ennittelt Die Suche des Kreuzungspunkts ist alierdings 
langwierig. 

Aufgabe der Erfindung ist es daher, ein verbessertes Verfahren zum Einmessen 
eines Arbeitspunktes von Werkzeugen fur industrieroboter zu schaffen. 
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Die Aufgabe wird mit dem gattungsgemalSen Verfahren erfindungsgemaS 
gel6st durch die weiteren Schritte von: 

c) Aufnehmen von IST-TCP-Lagekoordinaten bei der Unterbrechung 
5 einerjeweillgenUchtschranke, 

d) Bestimmen der Differenzen zwischen SOLL-TCP-Lagekoordinaten 
fOr die Unterbrediung der Llchtschranken bei einem SOLL- 
Arbeitspunkt und den entsprechenden aufgenommenen IST-TCP- 

10 Lagekoordlnaten filr den IST-AiteltspmW:, 

e) Berechnen der Abweichung des IST-Arbeitspunktes von dem 
SOLL-Arbeitspunkt fur die durch die Liclntschranken vorgegebene 
Anzahl von Ebenen aus den Differenzen und der bekamten Lage 



1 5 und Scheitelwlnkein a der Lichtschranken. 

Es wird somit vorgeschlagen, aus der bekannten durch die Lichtsdiranken 
aufgespannten Ebene und dem mindestens einen Sclieitelwinkel a die 
Abweichung des IST-Arbeitspunktes von dem SOLL-Arbeitspunkt aus den IST- 

20 TCP-Lagekoordinaten fOr jede Achse des Koordinatensystems, die jeweils beim 
Unterbrechen einer Lichtschranke festgehalten werden, auf die Abweichung 
des Arbeitspunktes ffir einzelne Achsen des Koordinatensystems zu berechnen. 
Damn entrant die Suche nadi dem Kreuzungspunkt zur Bestimmung eines 
Arbeitspunktes. Vielmehr kann der Roboter In die Einmessvorrichtung so 

25 verfahren werden, als ob der SOLL-Arbeitspunkt von der Werkzeugspitze direkt 
erreicht werden soil. Aus den bei einer Arbeitspunktverschiebung auftretenden 
zeitlich versetzten Unterbrechungen der elnzelnen Lichtschranken, deren 
Orlentierung einen Zusammenhang mit dem Koordinatensystem des 
Industrieroboters aufweist, kann dann die Abweichungen des Arbeitspunktes 

30 bestimrrtt werden. 



wo 2005/084895 



6 



PCT/DE2005/000262 



'^^ anschlieSend die TCP-Lagekoordinaten um dis 

berechnete Abwelchung des IST-Arbeitspunktes von den SOLL-Aiteitspunkt fQr 
die Ebenen eines dem TCP-Lagekoordinaten zu Gmnde liegenden 
Koordinatensystems kon^lgiert wird. 

Besonders vorteilhaft ist es auch, wenn der SOLL-Arbeitspunkt mit den TCP- 
Lagekoordinaten festgelegt wind, bei denen die dem Arbeitspunkt 
entsprechende Werkzeugspltze alle LIchtschranken in einem gemeinsamen 
Kreuzungspunkt gleichzeitig unterbriclit 

Deutllcher wird die Erfindung anhand einer vorteilhaften AusfQhrungsfonn, bei 
der zwel Lichtschranken vorgesehen sind, die sich mit einem Scheitelwinkel a 
von 90" kreuzen und eine erste Ebene eines Koordinatensystems aufspannen. 
^Q^®' die ers te Lichtschranke einer er sten Achse y und die_ zareits 
Lichtschranke einer zwejten Achse z des Koordinatensystems entspricht. 

Aus der beim Unterbrechen der ersten Lichtscliranke bestimmten Abweichung 
des IST-Arbeitspunktes vom SOLL-Arbeitspunkt kann auf Grund der definlerten 
Zuordnung der Lichtscliranken zu der ersten und zweiten Achse die 
Abweichung des Arbeitspunktes fur die erste Achse und aus der beim 
Unterbrechen der zweiten Lichtschranke bestimmten Abweichung des IST- 
Arbeitspunktes vom SOLL-Arbeitspunkt die Abweichung des Arbeitspunktes «ir 
die zweite Achse bestimmt werden. 

Sofem die TCP-Lagekoordinaten, die beim Unterbrechen der Uchtschranken 
bestimmt werden, im selben Koordinatensystem beschrieben sind, wQrde je 
nach Werkzeugverbiegung beispielsweise beim Unterbrechen der ersten 
Lichtschranke die Abweichung der y-Koordinate der TCP-Lagekoordinaten und 
beim Unterbrechen der zweiten Uchtschranke die Abweichung der z-Koordinate 
der TCP-Lagekoordinaten bestimmt und gegebenfalls die TCP-Lagekoordinaten 
entsprechend korrigiert werden. 
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Die Erfindung wird nachfolgend anhand der beigefugten Zeichnungen nSher 
erlSutert Es zeigen: 



Figur 1- perspektivische Ansicht einer erfindungsgemiden 

5 Einmessvorrlchtung mit zwei sich kreuzenden Lic{Ttschranl<en; 

Figur 2 - Draufsicht auf die E inmessvonichtung nach Rgur 1 ; 

Figur 3- Sklzze eines Industrleroboters mit mehreren Armen und 

10 Basisl<oordinatensystem sowie Achsenkoordinatensystemen; 

Figur 4- Skizze der Verlagerung des Arbeitspunktes eines Werkzeugs 
nacli VerschleiS in Bezug auf ein TCP-Koordinatensystem. 



15 Die Figur 1 l§sst eine erfindungsgemSBe Einmessvorrichtung 1 in 
perspektlvischer Ansicht erkennen. Die Einmessvorrichtung 1 hat einen auf 
einer Serte offenen Rahmen 2 mit zwei voneinander beabstandeten parallelen 
Schenkein 3a, 3b. Die Einmessvom'chtung 1 ist somit U-f6nmig. Die Schenkel 
3a, 3b sind integral mit einer Halteplatte 4 verbunden, mit der die 

10 Einmessvorrichtung 1 ortsfest in dem Arbeitsraum des Industrieroboters 
montiert werden kann. 



In den Schenkein 3a, 3b sind diagonal hierzu ausgerichtete Lichtschranken 5a. 
6b vorgesehen, dfe mit einem Scheitelwinkel a von 90° zueinander verlaufen 

5 und sich in einem Kreuzungspunkt R im Zwischenraum zwischen den 
Schenkein 3a, 3b treffen. Hierzu ist jeweiis ein Sender 6 und ein EmpfSnger 7 
pro Lichtschranke 5a, 5b an einem vorderen Ende eines ersten Schenkels 3a 
und am hinteren Endes des anderen Schenkels 3b fur die erste Lichtschranke 
5a bzw. an dem hinteren Ende des ersten Schenkels 3a und dem vorderen 

5 Ende des zweiten Schenkels 3fc> fur die zw'eite Lichtschranke 5b angebracht. 
Auf diese Weise wird eine Gabellichtschranke geschaffen, die vorzugsweise als 
Infrarot-Lichtschranke ausgebildet ist 
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Die FIgur 2 l§sst die Einmessvom'chtung 1 in der Draufsicht erl<ennen. Es wird 
deutlicli, dass die Lichtschranken 5a. 5b diagonal zwischen den Schenkein 3a 
und 3b veriaufen und sich im Zwischenraum der Schenkel 3a, 3b in dem 
5 Kreuzungspunkt R treffen. 

Ein Arbeltspunkt TCP eines Werkzeugs fur einen Industrleroboter, 
beisplelsweise die Werkzeugspitze, wird zum Einmessen des Arbeitspunktes 
TCP so verfehren, dass ein SOLL-Arbeitspunkt TCPsoll angefahren wird, der 
1 0 vorzugsweise dem Kreuzungspunkt R der Einmessvom'chtung 1 llegt In diesem 
Falle sind beide Lichtschranken 5a, 5b durch die Werkzeugspitze unterbrochen, 
so dass ein Schaitsignal erzeugt wird. 

D as E in messverfahren wir d [m F olgende n n aher eriiut ert 

15 

Die Figur 3 [§sst eine Skizze eine3 Industrieroboters 8 erkennen. Ein 
Industrieroboter 8 hat ein Basiskoordlnatensystem oder 
Weltkoordinatensystem, das ortsfest in Bezug auf das Fundament des 
Industrieroboters 8 ausgerichtet ist An dem Sockel 9 befindet sich eine Kette 
20 von Qber Gelenke 1 0 miteinander verbundene Arme 1 1 . FDr jeden dieser Arme 
11 ist ein Achsen-Kbordinatensystem O,, 0^, 0, definiert, mit dem Position 
und Orientlerung des jeweiligen Endes des entsprechenden Anns 11 in Bezug 
auf das zugeordnete Gelenk 10, mit der Anm 11 mit dem vorhergehenden Arm 
1 1 verbunden ist, beschrelbt 

25 

An dem Ende der Kette von Annen 1 1 befindet sich eine Handflache 12, an die 
das Werkzeug 13 angebracht ist. 

FQr das Werkzeug 13 ist ein TCP-Koordlnatensystem festgejegt, das 
30 einen Ursprung in dem Arbeitspunkt TCP des Werkzeugs hat. FQr das 
Werkzeug 13 werden auf der Basis dieses TCP-Koordinatensystems Otcp TCP- 
Lagekoordlnaten bereitgesteilt, die die Position und Orientlerung des 



wo 2005/084895 



9 



PCT/DE2005/000262 



Arbeitspunktes TCP in Bezug auf den Werkzeugbasispunkt W am Handflansch 
12, d. h. in Bezug auf den Befestigungspunkt des Werkzeugs 13 an dam 
Industrieroboter 8 definiert 

5 Um die TCP-Lagekoordinaten Im Betrleb bezogen auf den Werkzeugbasispunkt 
W des Industrieroboters 8 schnell und mit geringen Rechenaufwand einmessen 
zu kSnnen, wird die Werkzeugspitze des Werkzeugs 13 in den SOLL- 
Arbeitspunkt TCPsou. der ortsfest montierten Einmessvorrichtung 1 auf der 
Basis des TCP-Koordinatensystems 0^ verfahren. Es erfolgt somit eine auf 
10 den Arbeitspunkt TCP bezogene Interpolation des Verfahrweges beim Fuhren 
des Werkzeugs 13 durch den Industrieroboter 8. Der Ursprung des TCP- 
Koordinatensystems O^p wird hierbei stationer in Bezug auf die festgelegten 
TCP-Lagekoordinaten des Arbeitspunktes TCP gehalten. 

15 Beim Unterbrechen der ersten Lichtschranke werden die TCP-Lagekoordinaten 
festgehalten und die Abweichung des IST-Arbeitspunktes TCPist vom SOLL- 
Arbeltspunkt TCPsoa fOr die Achse y bestimmL Entsprechend wird beim 
Unterbrechen der zweiten Lichtschranke die Abweichung des IST- 
Arbeitspunktes TCPisT vom SOLL-Arbeitspunkt TCPsou. fOr die zweite Achse z 

20 bestimmt. Diese Abweichungen fQr die erste Achse y und die zweite Achse z 
entsprechen unter BerOcksichtigung, dass die beiden Lichtschranken eine 
gemeinsame Ebene aufspannen, die fDr die dritte Achse x im Nullpunkt 
durchfahren wurde, der Verschiebung des Arbeitspunktes TCP im 
dreidimensiionalen Raum. Die Reihenfolge der Unterbrechung eipibt sich durch 

25 die Werkzeugbiegung bzw. die Durchfahrtsteuerung. 

Der tatsSchliche Werkzeugmittelpunkt wird durch den Mittelpunkt zwischen 
Unterbrechung und emeuter Freigabe einer Lichtschranke bestimmt. Aus der 
Dauer der Unterbrechung kann zudem der Durchmesser des Werkzeugs 
20 bestimmt werden. 
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^"^^ ^^®'^4"9 somit ohne aufwendige Suche des 

Kreuzungspunktes R direkt die Verschiebung des Arbeitspunktes TCP bel 
Verschleifi Oder Verbisgen des Werkzeugs 13 in den TCP-Koordinaten 
bestimmt werden. Es entfailt auch die Notwendlgkelt, aufwendige 
5 Koordinatentransfonnationen durchzufQhren. 

Die Rgur 4 l§sst das Werkzeug 13 mit dem TCP-Koordinatensystem Oj^ 
erkennen, dass seinen Urspmng im Arbeitspunkt TCP des Werkzeugs 13 hat. 
FQr den Fall der skizzierten VerkrOmmung des Werkzeuges veriagert sich der 
0 Arbeitspunkt TCPi in Bezug auf den vorher festgelegten ursprungfichen 
Arbeitspunkt TCPo . Die TCP-l^ekoordinaten sind um diese Verscfiiebung 
ATCPo=TCPi-TCPo zu korrigieren. Da erfindungsgemiS die Steuerung des 
Industrie-Roboters 8 in Bezug auf das TCP-Koordinatensystem 0^ erfolgt, 
T?Mrd— die-" "Difi^renz zwlsdierT den TTrsprSnglich festgelegteh^tCP-' 
5 Lagekoordinaten TCPo und die Lage des neuen Arbeitspunktes TCPi eines 
versclnlissenen Werkzeugs 13 aus den Differenzen Ay beim Unterbrechen der 
ersten Liciitschranke fQr die y-Achse und Az beim Unterbrechen der zweiten 
Lichtschranke fQr die z-Achse bestimmt Da die durch die Licjhtschranken 
aufgespannten Ebene bei x gleich Null liegt, kann zu dem die Abwefchung Ax 
zum x-Wert des SOLL-Arbeitspunktes berechnet werden. 

Abweichungen der WerkzeugiSnge in x-Richtung kSnnen beispielsweise durch 
eine zweite Messfahrt bestimmt werden, indem das Werkzeug in x- 
Achsrichtung von oben bzw. unten in die sich kreuzenden Lichtschranken 
gefahren wird. 

Sofem die Lichtschranken nicht mit den x-, y- und z-Achsen ubereinstimmen, 
kSnnen aus der bekannten Orientierung der Lichtschranken und dem 
Scheitelwinkel a durch Koordinatentransformation die Abweichungen in x-, y- 
und z-Achsenrichtung berechnet werden. 
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Patentanspriiche 

1 . Verfahren zum EInmessen eines Arbeitspunktes (TCP) von Werkzeugen 
(13) fur Industrieroboter (8) mit einer Einmessvorrlchtung (1), die 
mindestens zwel jeweils mit einem Scheitelwinkel (a) groBer Null winkiig 
zueinander stehende und sich in einem Kreuzungspunkt (R) kreuzende 
LIchtschranken hat, mit den Schritten: 

a) Festlegen von SOLL-TCP-Lagekoordinaten eines SOLL- 
Arbeitspunktes (TCPsou.) des Werkzeugs (13) bezogen auf einen 
Werkzeugbasispunkt (W) des Industrieroboters (8) und eines auf 
den Arbeitspunkt (TCP) bezogenen TCP-Koordinatensystems, 

VejM!ren_deaJflfeckZ€aLigs_Cia) direkt-zum-aOLUAFbeftspunkt-rait 

Bezug auf das TCP-Koordinatensystem durch die Lichtschranken 
so, dass die dem Arbeitspunkt (TCP) entsprecliende 
Werkzeugspitze des Werkzeugs (13) die Lichtschranken 
unterbricht, 

gekennzeichnet durch 

c) Aufnehmen von IST-TCP-Lagekoordinaten bei der Unter- 
brechung einer jeweiligen Lichtschranke, 

d) Bestimmen der Differenzen zwischen den SOLL-TCP- 
Lagekoordinaten fQr die Unterbrechung der Lichtschranken bei 
einem Soll-Arbeitspunkt (TCPsou.) und den entsprechenden 
aufgenommenen IST-TCP-Lagekoordinaten fOr den IST- 
Arbeltspunkt (TCPist), 

e) Berechnen der Abweichung des IST-Arbeifspunktes (TCPist) von 
dem Soll-Arbeitspunkt (TCPsou) fQr die durch dieJJciit^ 
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^Y?J"9®9®^.D® Anzahl von Ebsnen aus den Differenzen und der 
bekannten Lage und Scheitelwinkein (a) der Lichtschranken. 

2. Verfahren nach Anspmch 1, gekennzelchnet durch Kom'gleren der TCP- 
Lagekoordlnaten urn die berechnete Abweldhung zwischen den 
festgelegten IST-TCP-Lagekoordinaten um die berechnete Abweicliung 
des IST-Arbeitspunktes (TCPist) und von dem SOLL-Arbeitspunkt 
(TCPsoii) fOr die Ebenen eines den TCP-Lagekoordinaten zu Grunde 
liegenden Koordinatensystems. 

3. Verfahren nach einem der vorherigen Anspruche, dadurch 
gekennzeichnet, dass der Soll-Arbeitspunkt (TCPsoll) mit den TCP- 
Lagekoordinaten festgelegt wird, bei denen die dem Art>eitspunkt (TCP) 

entsprediende WerisjeugsP-te- - alls. Lichtschranken in einera 

gemeinsamen Kreuzungspunkt (R) gleichzeitig unterbridit. 

4. Verfahren nadn einem der vorherigen Anspruche, wobei zwei 
Lichtschranken vorgesehen sind, die sich mit einem Scheitelwinkel a von 
90* kreuzen und eine erste Ebene eines Koordinatensystems 
aufspannen, und wobei die erste Lichtschranke einer &rsten Achse (y) 
und die zweite Lichtschranke eIner zweiten Ac^se (z) des 
Koordinatensystems entspricht, dadurch gekennzeichnat, dass aus der 
beim Unterbrechen der ersten Lichtschranke bestimmten Abweichung 
des IST-Arbeitspunktes (TCPist) vom SOLL-Arbeitspunkt (TCPsoll) die 
Abweichung des Arbeitspunktes (TCP) fur die erste Achse (y) und aus 
der beim Unterbrechen der zweiten Lichtschranke bestimmten 
Abweichung des IST-Arbeitspunktes (TCPist) vom SOLL-Arbeitspunkt 
(TCPsoll) die Abweichung des Arbeitspunktes (TCP) fQr die zweite 
Achse (z) bestlmmt wird. 

5. Verfahren nach einem der vorhergehenden Anspruche, gekennzeichnet 
durch Bestimmen der IST-TCP-Lagekoordinaten als mittlere IST-TCP- 
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Lagekoord'mate zwischen dem ZeKpunkt der Unterbrechung einer 
Lichtschranke und derfblgenden Freigabe der Lichtschranke. 

6. Verfahren nach Anspruch 5, gekennzelchnet durch Bestimmung des 
Werkzeugdurchmessers aus der Differenz der zum Zeitpunkt der 
Unterbrechung eIner Lichtschranke und der folgenden Freigabe der 
Lichtschranke bestimmten IST-TCP-Lagekcx>rdinaten. 
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Fig. 4 



